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(57)Abstract: 

PURPOSE: To improve the response to inclination detection and the detection 
accuracy. 

CONSTITUTION: This detector is equipped with a combination of a gravity type 
inclination sensor and gyro. When the gyro detection angle is stable, the angle 
detected by the gravity-type inclination sensor is regarded as the final detection 
angle, while, when the gyro detection angle deviates, the gyro detection angle is 
added to the angle detected by the gravity-type inclination sensor and stored to 
the memory (the standard value), while the gyro is stable, and the total is 
regarded as the final detection angle. 
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CLAIMS 
[Claim(s)] 

[Claim 1] It is the mobile agricultural machinery which performs inclination 
attitude control based on tilt-angle detection of a transit airframe or the activity 
section. To this mobile agricultural machinery A transit airframe or the gravity 
equation inclination sensor of the activity section which detects a tilt angle 
absolutely, When the detection angle of the gyroscope which detects the relative 
tilt angle of a transit airframe or the activity section, and a gyroscope is a stable 
state At the time of the stability which uses the detection angle of a gravity 
equation inclination sensor as a final detection angle, and stores the detection 
angle of a gravity equation inclination sensor as a reference value, a detection 
means, Inclination detection equipment of the mobile agricultural machinery 
characterized by establishing a detection means at the time of the fluctuation 
which adds the detection angle of a gyroscope to said reference value, and is 
used as a final detection angle when the detection angle of a gyroscope is in a 
fluctuation condition. 



DETAILED DESCRIPTION 



[Detailed Description of the Invention] 
[0001] 

[Industrial Application] This invention relates to the inclination detection 
equipment of mobile agricultural machineries, such as a tractor, a transplanter, a 
management machine, and a harvester. 
[0002] 

[Description of the Prior Art] Although some which perform inclination attitude 
control based on tilt-angle detection of a transit airframe or the activity section 
were generally in this seed mobile agricultural machinery, as a sensor for 
tilt-angle detection, gravity equation inclination sensors, such as a pendulum 
sensor, were used conventionally. However, in the gravity equation inclination 
sensor, in order that inertial force might act on detection objects, such as a 
pendulum, it cannot follow in footsteps of rapid inclination fluctuation, but the 
actual condition was inferior to responsibility. Then, although performing 
tilt-angle detection using the gyroscope possessing high-speed responsibility is 
proposed, since an error arises also in case a detection angle is calculated from 
****** which property change produces in connection with the temperature 
change of the electronic parts which constitute amplifier etc., and a gyroscope 
output, when tilt-angle detection is continued [ long duration ], in a gyroscope, 



there is un-arranging [ that an error is accumulated and detection precision falls J. 
[0003] 

[Means for Solving the Problem] This invention is originated for the purpose of 
offering the inclination detection equipment of the mobile agricultural machinery 
which can sweep away these faults in view of the actual condition like the above. 
It is the mobile agricultural machinery which performs inclination attitude control 
based on tilt-angle detection of a transit airframe or the activity section. To this 
mobile agricultural machinery A transit airframe or the gravity equation 
inclination sensor of the activity section which detects a tilt angle absolutely, 
When the detection angle of the gyroscope which detects the relative tilt angle of 
a transit airframe or the activity section, and a gyroscope is a stable state At the 
time of the stability which uses the detection angle of a gravity equation 
inclination sensor as a final detection angle, and stores the detection angle of a 
gravity equation inclination sensor as a reference value, a detection means, 
When the detection angle of a gyroscope is in a fluctuation condition, it is 
characterized by establishing a detection means at the time of the fluctuation 
which adds the detection angle of a gyroscope to said reference value, and is 
used as a final detection angle. And it enables it for this invention to raise the 
responsibility and detection precision of tilt-angle detection by this configuration. 
[0004] 



[Example] Next, one example of this invention is explained based on a drawing. 
In the drawing, 1 is the transit airframe of a tractor and is connected with the 
posterior part of this transit airframe 1 free [ rise and fall of the activity sections 3, 
such as a rotary, ] through the rise-and-fall link mechanism 2. And although the 
cant of the activity section 3 is carried out based on telescopic motion of the lift 
rod cylinder 6 while vertical rocking of the lift arm 5 accompanying telescopic 
motion of a lift cylinder 4 is interlocked with and it goes up and down, as for all, 
these basic configurations are the same as before [ the section ]. 
[0005] 7 is a gravity equation inclination sensor formed in said transit airframe 1 , 
and although attached that a tilt angle should be detected absolutely, as for this 
gravity equation inclination sensor 7, the gyroscope 8 (angular-velocity output 
type) of an airframe longitudinal direction (the rolling direction) which detects the 
relative tilt angle of the same direction as the gravity equation inclination sensor 
7 is further put side by side on the transit airframe 1 . 

[0006] Furthermore, although the control section 9 constituted using a 
microcomputer etc. is formed in said transit airframe 1 This control section 9 is 
added to the gravity equation inclination sensor 7 and gyroscope 8 which were 
mentioned above. Inclination automatic control The axle rotation sensor 13 for 
detecting the rod length sensor 12 for detecting the actuation length of the 
inclination setting volume 1 1 for setting up the inclination automatic switch 10 for 
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ON-OFF, and the target inclination of inclination automatic control, and the lift 
rod cylinder 6, and a run state (The intermittence pilot switch of a transit clutch is 
also good) etc. from - while inputting a signal, it is constituted that an 
actuation command should be outputted to the solenoid 14 for expanding of an 
electro-magnetic valve which operates the lift rod cylinder 6, and the solenoid 15 
grade for contraction. That is, although a control section 9 performs various 
control, such as tilt-angle detection control which detects the cant angle of the 
transit airframe 1 based on the output of said gravity equation inclination sensor 
7 and a gyroscope 8, and inclination automatic control which carries out 
inclination control of the activity section 3 automatically based on the 
comparison with said detection angle and target tilt angle, it explains hereafter 
the tilt-angle detection control which this invention makes a summary in full detail 
based on a flow chart. 

[0007] Now, although a run state is judged after calculating the tilt angle 
(absolutely tilt angle) S first in tilt-angle detection control based on the detection 
data of the gravity equation inclination sensor 7 sampled for every 
predetermined time In transit being under halt, while storing the neutral value 
(gyroscope data in case angular velocity is "0") of a gyroscope 8, said tilt angle S 
is stored in the "tilt-angle" variable which stores a final detection tilt angle 
(reference data of inclination automatic control). 



[0008] On the other hand, it judges whether when an airframe is running, the 
angular velocity which the gyroscope 8 outputted is abbreviation "0", and when 
this decision is YES, it judges whether predetermined timer time amount (it is 
abbreviation correspondence to the . response time of the gravity equation 
inclination sensor 7) passed. That is, although it judges whether the condition 
that angular velocity was abbreviation "0" carried out predetermined time 
continuation, when this decision is YES, said tilt angle S is stored in a 
"reference-value" variable and a "tilt-angle" variable. 

[0009] Moreover, when angular velocity is not in the condition of abbreviation "0", 
or when the condition of abbreviation "0" is under predetermined time, based on 
the detection data of a gyroscope 8, the tilt angle (relative tilt angle) G is 
calculated, namely, - while subtracting said neutral value from the detection 
data of a gyroscope 8 - the difference - although data are integrated for every 
sampling time and said tilt angle G is obtained, after calculating the tilt angle G, 
said reference value is added to the tilt angle G, and it stores in a "tilt-angle" 
variable. 

[0010] Although inclination control of the activity section 3 will be automatically 
carried out based on the tilt angle which detected and detected the tilt angle of 
the transit airframe 1 in the example of this invention constituted like description 
using the gravity equation inclination sensor 7 and the gyroscope 8 In order that 



the angular velocity which the gyroscope 8 detected may apply the tilt angle S 
calculated based on the detection data of the gravity equation inclination sensor 
7 in the condition of abbreviation "0", a small absolute tilt angle with error will be 
obtained. On the other hand in the condition that said angular velocity is not 
abbreviation "0" While calculating the tilt angle G based on the detection data of 
a gyroscope 8, in order to add a reference value to the calculated tilt angle G and 
to obtain a tilt angle, It becomes possible to perform tilt-angle detection excellent 
in responsibility, and moreover, since said reference value is an absolute tilt 
angle (tilt angle S) stored whenever angular velocity is omitted "0", it can also 
cancel un-arranging [ by which the error by property change and the error by the 
operation are accumulated ]. Therefore, it can become possible to use 
effectively the advantage of the gravity equation inclination sensor 7 and a 
gyroscope 8, consequently the responsibility and detection precision of tilt-angle 
detection can be raised to coincidence. 

[0011] In addition, this invention of it being what is not limited to said example is 
natural, for example, although angular velocity has switched the computing type 
of a detection angle on the basis of the condition of being abbreviation "0" in said 
example using the angular-velocity output type gyroscope, it is also possible to 
switch the computing type of a detection angle on the basis of the condition that 
angular acceleration is abbreviation "0" using an angular-acceleration output 



type gyroscope. 
[0012] 

[Function and Effect] In short, above this invention, performing inclination 
attitude control based on tilt-angle detection of a transit airframe or the activity 
section, since it is constituted like description Have the gravity equation 
inclination sensor and the gyroscope, and when the detection angle of a 
gyroscope is a stable state While using the detection angle of a gravity equation 
inclination sensor as a final detection angle, when the detection angle of a 
gyroscope is in a fluctuation condition Since the detection angle of a gyroscope 
is added to the detection angle (reference value) of the gravity equation 
inclination sensor stored at the time of gyroscope stability and it considers as a 
final detection angle, the tilt-angle detection in which each advantage was 
employed efficiently is attained. That is, at the time of gyroscope stability, while 
an absolute tilt angle with few errors is detectable, at the time of gyroscope 
fluctuation, tilt-angle detection excellent in responsibility can be performed, and 
since it is updated whenever the detection angle of a gyroscope is stabilized by 
the reference value of a gyroscope, moreover, it can also cancel un-arranging 
[ by which the error by property change and the error by the operation are 
accumulated ]. 



DESCRIPTION OF DRAWINGS 



[Brief Description of the Drawings] 

[Drawing 1] It is the side elevation of a tractor. 

[Drawing 2] It is the block diagram showing I/O of a control section. 

[Drawing 3] It is the flow chart of tilt-angle detection control. 

[Description of Notations] 

1 Transit Airframe 

3 Activity Section 

7 Gravity Equation Inclination Sensor 

8 Gyroscope 

9 Control Section 
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